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ABSTRACT 

This  paper  presents  the  results  of  an  investigation  of  target  motion  analysis 
algorithms  that  are  designed  to  cope  with  model  uncertainty.  First,  some 
standard  recursive  algorithms  such  as  the  cartesian  extended  Kalman  filter, 
modified  polar  extended  Kalman  filter,  and  cartesian  unscented  Kalman  filter 
are  applied  to  a  target  motion  analysis  problem  with  model  uncertainty,  in 
order  to  analyse  the  robustness  of  such  algorithms  in  these  conditions.  Next, 
some  adaptive  algorithms  are  investigated.  They  are  the  static  multiple  models 
and  the  dynamic  multiple  models  estimators,  namely:  two  generalised  pseudo 
Bayes  methods  and  the  interacting  multiple  model  method.  In  this  paper,  the 
problem  is  restricted  to  a  single  sensor  and  a  single  non-manoeuvring  target 
that  travels  at  constant  velocity.  Both  static  and  dynamic  sensor  performances 
are  considered.  For  simplicity,  only  Gaussian  measurement  noise  is  considered. 
Adaptive  filters  are  shown  to  have  promise:  they  can  establish  a  useful  bearing 
standard  deviation  adaptively  and  robustly. 
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Investigation  of  Target  Motion  Analysis  in  the  Presence  of 

Model  Uncertainty 

Executive  Summary 

This  work  was  carried  out  under  the  Task  07/093  for  the  Tracking  and  Data  Fusion 
subprogram  within  the  Submarine  Operations  Branch  at  DSTO  Stirling. 

In  this  paper,  the  effect  of  model  uncertainty  in  target  motion  analysis  (TMA)  per¬ 
formance  is  investigated.  This  includes  investigating  the  mismatch  of  bearing  mean  and 
variances  between  the  model  and  the  system.  The  recursive  bearings-only  TMA  algo¬ 
rithms  considered  are  the  cartesian  extended  Kalman  filter  (CEKF),  modified  polar  EKF 
(MPEKF),  and  cartesian  unscented  Kalman  filter  (CUKE).  Next,  the  designs  of  robust 
TMA  algorithms  that  are  capable  of  tracking  in  the  presence  of  model  uncertainty  are 
explored.  These  are  adaptive  filters,  namely  the  static  multiple  models  (SMM)  and  the 
dynamic  multiple  models  estimators.  The  dynamic  multiple  models  estimators  considered 
in  this  work  are  the  generalised  pseudo  Bayes  (GPBl  and  GPB2)  and  the  interacting 
multiple  model  (IMM)  algorithms. 

The  problem  considered  in  this  paper  is  restricted  to  an  ownship  with  a  single  sensor 
observing  a  single  non-manoeuvring  constant- velocity  target.  The  ownship  must  manoeu¬ 
vre  for  the  algorithms  to  converge.  Three  scenarios  are  described,  encompassing  low  to 
high  rates  of  bearing  change,  but  only  one  of  these  is  analysed  in  detail;  the  similar  results 
of  the  others  are  merely  quoted. 

The  ownship  (a  submarine)  uses  passive  sonar  to  detect  a  target  (a  ship  or  a  sub¬ 
marine).  Two  passive  sensors  onboard  submarines  that  are  especially  used  for  tracking 
are  cylindrical  and  flank  arrays.  These  are  located  at  different  places  on  the  submarine, 
resulting  in  a  lowered  performance  for  each  in  the  relevant  zone.  The  cylindrical  array  has 
a  blind  arc  behind  the  submarine  from  where  it  receives  no  data  at  all.  The  beamwidth 
of  the  flank  array  is  narrow  to  broadside  and  broad  to  endfire  (front  and  behind  the  sub¬ 
marine),  giving  poor  endfire  performance.  In  this  paper,  both  static  and  dynamic  sensor 
performances  are  considered.  We  use  a  simple  model  for  the  dynamic  sensor  performance, 
namely,  two  fixed  bearing  standard  deviations:  one  for  each  half  of  the  scenario.  Also,  for 
simplicity,  this  paper  only  deals  with  Gaussian  measurement  noise. 

For  the  problem  with  a  static  sensor  such  as  a  cylindrical  array,  results  show  that  the 
CEKF  and  the  CUKF  perform  better  than  the  MPEKF.  We  show  that  filters  incorporating 
approximately  the  same  bearing  mean  and  error  as  those  of  the  system  outperform  filters 
that  are  not  matched  in  such  a  way.  This  suggests  further  investigation  into  adaptive  filters 
that  estimate  these  parameters  adaptively.  In  this  paper,  we  focus  solely  on  the  design 
of  adaptive  filters  for  eliminating  bearing  variance  mismatch  between  the  model  and  the 
system. 

The  filter  used  may  not  “know”  the  measurement  noises  (variances  and  biases).  When 
considering  static  sensor  performance,  the  adaptive  filter  (SMM)  has  been  shown  to  be 
promising  for  this  kind  of  problem.  The  SMM  can  estimate  a  bearing  standard  deviation 
adaptively,  with  results  comparable  to  the  performance  of  a  filter  that  uses  the  same  bear¬ 
ing  standard  deviation  as  that  of  the  system.  For  the  case  of  dynamic  sensor  performance, 
where  the  sensor  detection  ability  might  be  degraded  by  hardware  geometry,  there  are 
great  benefits  to  using  the  GPBl,  GPB2,  and  IMM  adaptive  filters,  because  these  can 
estimate  a  bearing  standard  deviation  adaptively  and  robustly.  We  show  that  they  give 


iii 


DSTO-TR-2405 


comparable  performance  to  that  of  an  ideal  filter  that  uses  the  dynamic  bearing  standard 
deviations  of  the  system.  The  results  obtained  from  the  IMM  and  GPB2  are  closer  to 
those  of  the  ideal  filter  than  the  GPBl.  The  GPBl  gives  a  marginally  smaller  position 
error  than  the  GPB2  and  the  IMM;  but  the  state  covariances  calculated  using  the  IMM 
and  GPB2  are  more  acceptable  under  the  statistical  test  for  consistency.  Note  that  the 
GPBl  is  marginally  quicker  to  process  than  the  IMM,  while  the  GPB2  is  easily  the  slowest. 
For  these  reasons,  the  IMM  appears  slightly  more  promising  to  use. 

We  conclude  that  filters  using  a  wrong  bearing  mean  or  error  can  produce  a  very  poor 
TMA.  We  show  that  adaptive  filters  can  give  improved  performance  in  the  case  where  the 
hlter  has  no  knowledge  of  the  measurement  noise.  This  is  a  theoretical  investigation  and 
it  is  proposed  to  investigate  further  with  real  data. 


DSTO-TR-2405 


Authors 


Tracy  Quyen  So  Truong 

Maritime  Operations  Division 

Tracy  Truong  graduated  from  Curtin  University  of  Technol¬ 
ogy  with  a  BSc  in  Mathematics  and  Computing  in  1994,  and  a 
BSc  (Hons)  in  Mathematics  (First  Class)  in  1995.  She  received 
her  MAppSc  in  Mathematics  at  RMIT  University  in  2005  with 
a  thesis  titled  “Exploration  of  a  Rendezvous  Search  Problem 
using  Genetic  Algorithms”. 

She  joined  DSTO’s  Air  Operations  Division  in  1996,  where 
she  supported  the  AP-3C,  F/A  18,  and  F-111  operational  tac¬ 
tics  studies  nsing  agent-oriented  programming.  In  2002  she 
transferred  to  Maritime  Operations  Division,  and  was  involved 
in  studies  on  effectiveness  tactics  for  the  Mk  48  torpedo,  as¬ 
sisted  in  studies  on  the  Mk  46  torpedo  defence,  and  provided 
exercise  analysis  tools  to  the  Submarine  Operational  Analysis 
Group. 

Recently  she  has  been  involved  in  projects  for  the  Sub¬ 
marine  Operations  Branch,  namely  target  tracking  and  fnsion 
within  the  Tracking  and  Data  Fusion  subprogram,  and  assessing 
the  mental  workload  impact  on  the  submarine  Track  Manager 
within  the  Combat  System  Design  subprogram. 


Don  Koks 

Electronic  Warfare  and  Radar  Division 

Don  Koks  completed  a  doctorate  in  mathematical  physics  at 
Adelaide  University  in  1996,  with  a  thesis  describing  the  use  of 
quantum  statistical  methods  to  analyse  decoherence,  entropy 
and  thermal  radiance  in  both  the  early  universe  and  black  hole 
theory.  He  holds  a  BSc  from  the  University  of  Anckland  in  pure 
and  applied  mathematics  and  physics,  and  an  MSc  in  physics 
from  the  same  university  with  a  thesis  in  applied  accelerator 
physics  (proton-indnced  X  ray  and  7  ray  emission  for  trace  el¬ 
ement  analysis).  He  has  worked  on  the  accelerator  mass  spec¬ 
trometry  programme  at  the  Australian  National  University  in 
Canberra,  as  well  as  in  commercial  internet  development. 

Currently  he  is  a  Research  Scientist  with  the  Maritime  Sys¬ 
tems  group  in  the  Electronic  Warfare  and  Radar  Division  at 
DSTO,  specialising  in  geolocation,  geospatial  orientation,  and 
weapon-target  allocation.  He  has  published  a  book  on  math¬ 
ematical  physics  called  Explorations  in  Mathematical  Physics: 
the  Concepts  Behind  an  Elegant  Language  (Springer,  2006). 


V 


DSTO-TR-2405 


DSTO-TR-2405 


Contents 

1  Introduction  1 

2  Bearings-Only  TMA  Problem  for  a  Non-Manoeuvring  Target  3 

3  Performance  Metrics  4 

4  Simulations  and  Parameter  Settings  6 

5  Results  for  the  Standard  Filter  Benchmarks  9 

5.1  Mismatch  of  the  Gaussian  variances  used  in  the  model  and  the  system  .  .  9 

5.2  Mismatch  of  the  Gaussian  means  used  in  the  model  and  the  system  ...  16 

6  Adaptive  Filters  19 

6.1  Static  Multiple  Models  Estimator  (SMM) .  19 

6.2  Dynamic  Multiple  Models  Estimator .  21 

6.2.1  Generalised  Pseudo  Bayes  Methods  (GPBl  and  GPB2) .  21 

6.2.2  Interacting  Multiple  Models  Method  (IMM) .  25 

7  Adaptive  Filters  Results  27 

7.1  Static  sensor  performance  case .  27 

7.2  Dynamic  sensor  performance  case  .  31 

8  Conclusion  and  Future  Directions  36 

9  Acknowledgements  37 

References  37 


vii 


DSTO-TR-2405 


DSTO-TR-2405 


1  Introduction 

In  this  paper,  the  effect  of  model  uncertainty  in  bearings-only  target  motion  analysis 
performance  is  investigated.  Bearings-only  target  motion  analysis  (TMA)  is  vital  to  a 
platform’s  defence.  TMA  applications  can  be  found  in  many  systems,  including  sonar 
systems,  airborne  warning  and  control,  missile  guidance,  and  anti  radiation  missiles.  Tar¬ 
get  motion  state  estimation  is  used  to  track  a  target,  avoid  collisions,  and  to  evade  and 
attack  a  target.  The  use  of  TMA  considered  in  this  report  involves  a  submarine  (ownship) 
tracking  a  ship  or  submarine  (target)  by  using  passive  sonar.  The  ownship  uses  a  passive 
system  so  as  not  to  reveal  its  presence.  Noisy  bearings  from  the  sound-radiating  target  are 
processed  to  produce  an  estimate  of  the  possibly  moving  target’s  state  (its  position  and 
velocity).  The  use  of  a  passive  system  means  that  target  range  is  not  explicitly  available. 

The  passive  sensors  onboard  submarines  that  are  particularly  used  for  tracking  are  the 
cylindrical  array  and  the  flank  array  [1].  The  cylindrical  array  is  located  in  the  submarine’s 
bow,  whereas  the  flank  array  comprises  panels  located  along  the  submarine’s  side.  The 
cylindrical  array  cannot  detect  anything  behind  the  submarine.  The  beamwidth  of  the 
flank  array  is  narrow  to  broadside  and  broad  to  endfire  (front  and  behind  the  submarine), 
giving  poor  endfire  performance.  The  flank  array  is  affected  by  beamsteer  direction,  while 
the  cylindrical  array  is  not.  Thus  when  the  flank  array  is  used  for  tracking,  the  beam 
pattern  changes  with  beamsteer  direction;  it  is  narrow  when  steering  to  broadside  (when 
the  direction  of  incoming  signals  is  perpendicular  to  the  array,  giving  the  best  base  line 
geometry),  and  broad  when  steering  to  endfire  (when  the  incoming  direction  aligns  with 
the  array,  giving  a  poor  base  line).  For  this  reason,  the  scenarios  investigated  in  this  paper 
are  divided  into  two  classes:  static  sensor  performance  (e.g.  using  a  cylindrical  array)  and 
dynamic  sensor  performance  (e.g.  using  a  flank  array).  The  dynamic  sensor  performance 
considered  in  this  report  is  a  simple  one,  defined  by  splitting  a  scenario  into  halves.  Each 
half  is  then  assigned  a  fixed  bearing  standard  deviation. 

Since  1960,  the  Kalman  filter  (KF)  has  been  one  of  the  most  widely  used  methods  for 
tracking,  due  to  its  simplicity,  optimality,  tractability  and  robustness.  But  its  application 
to  nonlinear  systems  can  be  fraught  with  difficulty.  The  most  common  approach  for  such 
systems  uses  the  extended  Kalman  filter  (EKF),  which  linearises  all  nonlinear  models  so 
that  the  traditional  linear  Kalman  filter  can  then  be  applied.  Though  widely  used,  the 
EKE  is  difficult  to  implement  and  tune;  it  is  only  reliable  for  systems  that  are  almost 
linear  on  the  update  interval  [2,  3].  New  nonlinear  estimators  have  been  developed,  such 
as  the  unscented  Kalman  filter  (UKE).  Unlike  the  EKE,  the  UKF  does  not  approximate 
nonlinear  functions;  instead,  it  parametrises  means  and  covariances  using  a  set  of  sampled 
points. 

Various  algorithms  have  been  used  for  the  bearings-only  TMA  problem  [4,  5,  6,  7].  In 
particular,  those  used  in  this  paper  are  the  cartesian  extended  Kalman  filter  (CEKF)  [8,  9], 
the  modified  polar  EKF  (MPEKF)  [9,  10],  and  the  cartesian  unscented  Kalman  filter 
(CUKF)  [2,  11,  12].  All  of  these  algorithms  are  recursive.  Unlike  batch  processing  tech¬ 
niques,  recursive  processing  does  not  require  some  or  all  of  the  previous  data  to  be  stored 
and  reprocessed  each  time  a  new  bearing  is  measured. 

Sonar  performance  depends  on  many  factors:  signal  frequency,  signal-to- noise  ratio, 
bearing,  bearing  rate,  array  type,  etc.  These  factors  certainly  influence  the  manufacturer’s 
specification  of  the  expected  measurement  noise  of  any  particular  sensor.  Literature  study¬ 
ing  bearing  measurement  noise  is  quite  limited.  In  order  to  estimate  the  target  state  ac- 
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curately,  the  estimator  needs  to  know  the  statistical  characteristics  of  the  measurement 
noise;  its  bias  (mean)  and  spread  (variance).  But  the  above  influences  mean  that  this 
information  is  not  always  known,  and  this  leads  to  the  design  of  adaptive  filters  that  can 
estimate  and  adjust  the  measurement  noise  parameters  as  new  data  arrives.  In  this  report 
we  focus  on  finding  the  variances  of  measurement  noises  adaptively.  We  are  also  concerned 
solely  with  single  sensor /single  target  tracking. 

Next,  we  explore  the  designs  of  adaptive  filters  that  are  capable  of  tracking  in  the 
presence  of  model  uncertainty.  These  are  the  static  multiple  models  (SMM)  and  the 
dynamic  multiple  models  estimators:  generalised  pseudo  Bayes  methods  (GPBl,  GPB2) 
and  the  interacting  multiple  model  method  (IMM).  The  algorithms  considered  are  not  new 
but  the  applications  to  the  problems  considered  here  are  new.  The  motivation  for  using 
adaptive  filters  for  this  problem  comes  from  [13],  which  shows  promising  results  for  using 
the  IMM  to  track  manoeuvring  targets  whose  motion  is  unknown. 

The  bearings-only  TMA  problem  considered  in  this  paper  assumes  a  constant- velocity 
target.  To  estimate  the  state  of  such  a  target  from  bearings-only  measurements,  it  is 
necessary  for  the  ownship  to  manoeuvre  at  least  once.^  On  the  other  hand,  dealing  with 
motion  uncertainty  of  a  target  that  moves  unpredictably  in  different  directions  and  with 
variable  speeds  is  much  more  difficult,  and  is  not  considered  here. 

The  class  of  model  uncertainty  investigated  in  this  paper  is  focused  on  the  mismatch 
of  measurement  noise  between  the  model  and  the  system,  namely: 

-  Mismatch  of  the  Gaussian  means;  i.e.  the  model  assumes  a  zero-mean  measurement 
noise  while  the  system  measurement  noise  is  non-zero  mean,  and 

-  Mismatch  of  the  Gaussian  variances. 

In  short,  the  primary  investigations  considered  in  this  paper  centre  on  these  two  questions: 

-  Benchmarking  of  the  algorithms  (CEKF,  MPEKF,  CUKE)  to  cope  with  different 
degrees  of  mismatch  as  stated  earlier.  In  other  words,  is  the  algorithm  robust  in  this 
circumstance? 

-  Can  we  design  adaptive  filters  to  recover  from  the  model  mismatch? 

This  paper  is  organised  as  follows. 

Section  2  describes  the  bearings-only  TMA  problem  for  a  non-manoeuvring  target; 
Section  3  describes  the  performance  metrics  used  in  our  analysis; 

Section  4  describes  the  simulations  and  parameter  values; 

Section  5  presents  experimental  results  and  discussions  for  the  standard  filters  (CEKF, 
MPEKF,  CUKE); 

Section  6  briefly  describes  the  adaptive  filters  used  in  the  simulations  (SMM,  GPBl, 
GPB2,  IMM); 

^Note  that  it  is  not  actually  sufficient  for  the  ownship  to  manoeuvre  in  order  to  estimate  the  target 
state  accurately.  A  complicated  manoeuvre  or  set  of  manoeuvres  might  be  needed,  and  the  accuracy  of 
the  state  estimate  can  begin  to  degrade  some  time  after  the  last  manoeuvre  finishes. 
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Figure  1:  A  typical  two-dimensional  target-observer  geometry 


Section  7  presents  experimental  results  and  discussions  for  the  adaptive  filters  (which 
only  use  multiple  CEKFs  and  CUKFs);  and  hnally 

Section  8  summarises  our  key  results  and  provides  some  recommendations  and  future 
research  directions. 


2  Bearings-Only  TMA  Problem  for  a 
Non-Manoeuvring  Target 


The  basic  scenario  considered  in  this  paper  is  shown  in  Figure  1.  This  is  a  classical  two- 
dimensional  bearings-only  TMA  problem  comprised  of  a  single  non-manoeuvring  target 
and  a  single  manoeuvring  observer  or  ownship  whose  trajectory  consists  of  two  legs,  each 
with  a  different  heading.  The  target  has  cartesian  position  {r\.,r^y)  and  moves  with  a 
nearly  constant  velocity  vector  We  write  its  state  vector  as 

,  (2.1) 


with  superscript  T  denoting  the  transpose  (i.e.  all  vectors  are  columns).  Similarly,  the 
ownship  state  is  written 


X 


o  _  o  ^ 

\_'  XI  ^y\ 


olT 


(2.2) 


where  the  velocity  vector  is  typically  constant  for  each  leg.  The  relative  state  vector  is 


X  —  X  X  —  '^xi  '^y] 


(2.3) 


Bearings-only  tracking  estimates  the  target  state  of  a  discrete  time  dynamic  process 
using  the  least  mean  squared  error  criterion.  The  target’s  relative  state  at  time  index 
A;  =  1,  2, . . .  is  modelled  by 

®fc+l  —  -|-  Vj^  ,  (^'4) 
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where  the  state  transition  matrix  for  a  sampling  interval  T  is 


F.  = 


T 

0 

1 

0 


Also 


U 


k,k+l 


\rl{k  +  1)  -  rl{k)  -  Tvl{k)' 
r°{k  +  1)  -  r°(A:)  -  Tv°{k) 

+  1) 

v°y{k  +  1)  -  vl{k) 

and  the  random  variable  models  the  process  noise,  assumed  Gaussian: 


Vk  ~  AA(0,  Qk) 


where 


Qk  =  Q 


'Ti 

0 

3 

0 

2^3 

2 

0 

rp2 

0 

T 

0 

j,2 

O 

0 

0 

'j^2 

~Y 

0 


q  =  process  noise  intensity  parameter. 


The  bearing  measurements  are  Zk- 

Zk  =  hk{xk)  +  Wk 


(2.5) 


(2.6) 


(2.7) 


(2.8) 


(2.9) 


where 


hk{xk)  =  true  bearing  9  =  tan  ^  ^  +  quadrant-dependent  constant,  (2-10) 

ry(k) 

and  the  random  variable  Wk  models  the  measurement  noise,  again  assumed  Gaussian: 


Wk  ~  AA(o,  (cr|) 


(2.11) 


3  Performance  Metrics 


In  order  to  compare  the  performance  of  various  tracking  algorithms,  100  Monte  Carlo 
simulations  were  run  for  each  algorithm,  implemented  using  Matlab.  Each  set  of  runs  used 
the  same  seed  for  the  random  number  generator;  this  ensured  that  the  same  set  of  bearings 
was  used  for  each  set  of  runs.  The  use  of  averaging  in  the  following  performance  metrics 
significantly  reduced  the  possibility  of  a  single  “lucky”  run — one  that  is  not  representative 
of  a  typical  algorithm  performance. 

The  performance  metrics  that  were  used  in  the  analysis  are  as  follows.  Suppose  there 
are  M  independent  Monte  Carlo  runs.  First,  the  root  mean  square  position  error 
(RMS)  at  time  (index)  k  is  defined  as 


RMSfc 


\ 


1  ^ 

-  rx{kYf+  [ry{kY  -  fy{kY]^  , 


2=1 


(3.1) 
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where  [rx{ky,ry{ky)  and  [rx{ky,fy{ky)  are  the  true  and  estimated  target  positions  at 
time  k  in  the  Monte  Carlo  run. 

Next,  for  a  particular  scenario  and  parameter  choice,  the  root  time-averaged  mean 
square  position  error  (RTAMS)  is  calculated.  Unlike  the  RMS  error  at  time  k,  the 
RTAMS  takes  multiple  times  into  account  and  so  is  a  more  complete  indicator  of  the 
algorithm’s  performance.  It  is  defined  as 

-1  ^max  M 

RTAMS  =  - - -  ’  (3.2) 

\  ^  ^  ^  k=l+l  i=l 

with  tmax  the  final  time  of  the  scenario,  and  I  a  time  after  which  the  averaging  is  carried 
out;  hence  tmax  ~  ^  is  the  interval  over  which  the  averaging  is  carried  out.  Typically,  I  is 
chosen  to  coincide  with  the  end  of  the  first  ownship  manoeuvre,  or  a  time  slightly  later. 
For  example,  I  was  set  to  the  index  appropriate  for  18  minutes  in  the  scenario  of  Figure  2 
(refer  to  Table  1  and  the  discussion  at  the  start  of  Section  5). 

The  norm  of  the  bias  position  error  at  the  final  time  is 

(3.3) 

where  (r^,r*)  and  are  the  true  and  estimated  target  positions  at  the  final  time 

tmax  in  the  Monte  Carlo  run. 

The  average  normalised  (state)  estimation  error  squared  (NEES)  at  time  k  is 

=  M  E  [(4  -  (niJ"'  (4  -  4)] .  (3.4) 

i=l 

where  x^.  and  are  the  true  and  estimated  state  vectors  [r^,  Vy,  Vx,  Vy]"’"  and  [rx,ry,  Vx,  Vy]'^ 
respectively,  and  =  IE  {(®^  —  x]yj{x\.  —  x\Y"\  is  the  covariance  matrix,  at  time  k  and 
Monte  Carlo  run. 

To  satisfy  the  consistency  criteria  for  a  filter,  the  state  errors  should  be  zero  mean 
with  magnitude  commensurate  with  the  state  covariance  as  yielded  by  the  filter.  That  is, 
the  state  estimation  errors  are  consistent  with  the  filter-calculated  covariances  if  NEES^ 
is  within  the  following  interval: 


where  Mn  =  400  is  the  number  of  degrees  of  freedom  for  the  test  (M  =  100  Monte 
Carlo  runs  and  n  =  4  is  the  dimension  of  the  x  state  vector),  and  a/2  is  the  “tails  part” 
of  the  two-sided  (1  —  a)-probability  concentrate  region.  (Further  details  can  be  found 
in  [14].) 

In  other  words,  assuming  the  state  estimate  to  be  unbiased,  if  NEES^  lies  within  the 
interval  of  (3.5),  we  deem  the  state  covariance  calculated  by  the  filter  to  be  acceptable. 
Still  assuming  no  bias,  if  NEES^  is  below  the  lower  bound,  we  infer  that  the  filter  has 
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overestimated  the  state  covariance.  Similarly,  if  NEESfc  is  above  the  upper  bound,  we 
infer  that  the  filter  has  underestimated  the  state  covariance; 


Pk\k  overestimated  Pk\k  acceptable  Pk\k  underestimated 


NEESfe,  no  bias 


4  Simulations  and  Parameter  Settings 

Figure  2  shows  the  target-ownship  geometry  that  we  call  “Scenario  1”  and  use  throughout 
this  report.  Ownship  and  target  parameters  are  listed  in  Tables  1  and  2.  Parameter 
choices  are  straightforward,  with  the  possible  exception  being  those  describing  the  ownship 
manoeuvre.  The  ownship  maintains  a  constant  velocity  until  a  time  of  13  minutes,  when 
it  changes  to  a  heading  of  20°  with  a  turning  rate  of  0.5°/s.  It  maintains  this  new  heading 
until  the  end  of  the  observation  period  is  reached  after  30  minutes.  Bearing  measurements 
are  received  every  20  seconds,  with  a  nominal  bearing  accuracy  of  1.5°.  The  results 
presented  in  the  sections  to  follow  are  based  on  this  scenario,  in  which  the  rate  of  increase 
of  target  bearing  as  seen  by  the  ownship  peaks  at  12°/ min.  Two  other  scenarios  with 
lower  and  higher  bearing  rates  (peaking  at  2°/ min  and  40°/ min  respectively)  are  shown  in 
Figure  3.  Results  of  these  scenarios  show  trends  similar  to  those  of  Scenario  1,  and  so  are 
not  analysed  further  here. 

Figure  4  shows  typical  bearings  received  versus  time  for  each  of  the  three  scenarios. 
The  filters  were  initialised  by  the  method  proposed  in  Chapter  6  of  [11],  with  settings  listed 
in  Table  3.  These  settings  were  extracted  from  [11,  15,  16,  17]  for  range,  speed,  course  and 
process  noise  intensity  respectively.  For  each  Monte  Carlo  run,  parameters  were  chosen 
according  to 


initial  target  detection  range  r  ~  Af{f,  a'^) , 
initial  target  detection  speed  s  ~  AA(s,  , 
initial  target  detection  course  c  ~  AA(c,  a'^) . 

Other  filter  initialisations  (such  as  initial  state  vector  and  its  covariance)  were  obtained 
from  [11]. 


Table  1:  Ownship  parameters 


Initial  (x,  y)  position 

(0,0)  km 

Speed 

7kts  constant 

Heading 

140° 

(0  — )■  13  minutes) 

140°  ^  20° 

(13  — ^  17  minutes) 

20° 

(17  — ^  30  minutes) 

Rate  of  turn 

0.5°/s 

Bearing  measurement  interval 

20  s 

Bearing  measurement  error  Ug 

1.5° 
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Table  2:  Target  parameters 


Initial  range  10  km 

Speed  15  kts  constant 

Initial  true  bearing  60° 

Heading  195°  constant 


Target  and  Ownship  Geometry 


X  position  (km) 


Figure  2:  Scenario  1:  target-ownship  geometry 


Figure  3:  Scenarios  2  (left)  and  3  (right).  Their  analyses  are  not  presented 
in  this  report,  but  gave  results  similar  to  those  of  Scenario  1 
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Time  (min) 


Figure  Target  bearings  seen  by  ownship  as  a  function  of  time  for  Seenar- 
ios  1,  2  and  3 


Table  3:  Nominal  filter  parameters  for  a  target 


Range  mean  f 

15  km 

Range  standard  deviation  cjr 

6  km 

Speed  mean  s 

16  kts 

Speed  standard  deviation  as 

7kts 

Course  mean  c 

01  +  180°, 

where  9i  =  initial  bearing  measurement 

Course  standard  deviation  Uc 

180°//f2 

Process  noise  intensity  q 

0.001  X  10"®kmVs^ 
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5  Results  for  the  Standard  Filter  Benchmarks 

Presented  in  this  section  are  the  results  of  a  number  of  Monte  Carlo  runs  aimed  at  bench¬ 
marking  the  standard  algorithms  (CEKF,  MPEKF,  CUKE)  in  the  presence  of  model  mis¬ 
match.  Parameter  settings  for  the  non-manoeuvring  target  bearings-only  TMA  problem 
are  used,  as  described  in  the  previous  section. 

For  a  representative  run,  the  target  position  estimated  using  CEKF,  MPEKF,  and 
CUKE  algorithms  together  with  the  actual  target  position  are  plotted  in  Figure  5.  Here, 
the  system  and  filters  are  assumed  to  have  the  same  bearing  measurement  noise  statistics: 
zero- mean  Gaussian  with  standard  deviation  1.5°.  The  performance  of  the  filters — RMS 
position  error  versus  time — is  presented  in  Figure  6.  This  figure  shows  that  the  ownship 
completes  its  first  manoeuvre  after  about  17  minutes,  and  slightly  after  this  is  when  good 
convergence  to  the  ground  truth  begins.  (Thus,  referring  to  the  discussion  just  after  (3.2), 
we  set  I  =  18  minutes  in  that  equation.)  We  are  interested  in  the  performance  results 
from  this  time  onward,  so  focus  on  the  results  of  the  parameters  described  in  (3.1)-(3.4). 
In  order  to  simulate  a  model  mismatch,  the  following  experiments  are  considered,  with 
results  presented  in  Sections  5.1  and  5.2: 

Mismatch  of  the  Gaussian  variances  used  in  the  model  and  the  system 
(Section  5.1):  Here  the  system  bearing  measurement  noise  is  assumed  Gaussian 
with  zero  mean  and  varying  standard  deviation  Ug  =  1.5°,  2.5°,  3.5°,  4.5°.  These 
values  were  chosen  partly  with  reference  to  [1]  and  partly  from  past  data.  For 
each  fjg,  the  filters  (CEKF,  MPEKF,  CUKF)  simulate  a  bearing  noise  as  Gaussian, 
each  with  zero  mean  and  the  following  standard  deviations:  cjg/3,  <7^/2,  cjg,  2(Tg,3iTg 
and,  finally,  lOcig  (to  investigate  filter  performance  for  a  very  large  bearing  standard 
deviation) . 

Mismatch  of  the  Gaussian  means  used  in  the  model  and  the  system 
(Section  5.2):  In  this  case  the  system  bearing  measurement  noise  is  assumed  Gaus¬ 
sian  with  a  fixed  standard  deviation  cjg  =  1.5°,  but  now  with  a  mean  varying  over 
the  values  0°,  1°,  2°.  The  filters  simulate  a  bearing  noise  as  Gaussian  with  zero  mean 
and  the  same  standard  deviation  as  the  system  (cjg  =  1.5°). 

5.1  Mismatch  of  the  Gaussian  variances  used  in  the  model 
and  the  system 

This  section  presents  comparison  results  of  the  overall  performance  of  each  filter  (CEKF, 
MPEKF,  CUKF)  in  the  presence  of  bearing  measurement  variance  mismatch  between  the 
model  and  the  system  as  stated  in  the  immediately  foregoing  paragraphs. 

In  order  to  compare  the  overall  performance  of  the  filters,  the  following  plots  present 
their  data  as  a  function  of  the  standard  deviation  of  the  filters.  Note  that  the  “tick-mark 
spacing”  on  the  x  axis  of  these  plots  has  been  set  constant  for  convenience  only,  to  facilitate 
presenting  the  data  more  compactly. 

Figure  7:  RMS  position  error  at  the  final  time  of  t  =  30  minutes. 

Figure  8:  RTAMS  position  error  (an  average  over  the  18  — )■  30  minutes  interval), 
Figure  9:  norm  of  bias  position  error  at  t  =  30  minutes,  and 
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Figure  10:  log;^g  NEES  at  t  =  30  minutes. 

Eigures  7-9  show  that  filters  using  approximately  the  same  bearing  standard  deviation 
as  that  of  the  system  perform  better  than  those  using  a  smaller  estimated  error.  These 
figures  also  show  that  filters  using  a  larger  bearing  standard  deviation  than  that  of  the 
system  can  perform  better  than  those  using  the  same  bearing  standard  deviation,  except 
in  regards  to  the  NEES  of  Eigure  10.  We  see  on  a  further  examination  of  this  figure  that 
the  average  NEES  for  the  CEKE  and  CUKE  are  also  within  the  acceptable  average  bounds. 

The  acceptable  average  bounds  are  defined  to  be  the  average  NEES  bounds  obtained  from  [14], 
and  are  used  throughout  this  paper.  They  specify  the  interval  [xMn  (a/2),  xi,„(l-a/2)]. 

In  our  case,  M  =  100  Monte  Carlo  runs,  n  =  4  counts  the  dimensions  of  the  x  state  vector,  and 
a/2  =  2.5%  for  the  two-sided  95%  probability  region.  The  interval  of  the  acceptable  average 
bounds  is  thus  [xloo(0.025),  xloo(0.975)]  =  [3.46,4.57]. 

Overall,  taking  into  consideration  error  performance  and  NEES,  we  conclude  that  a  filter 
is  superior  if  it  uses  the  same  bearing  standard  deviation  as  that  of  the  system.  We  also 
observe  that  in  this  case,  the  state  covariances  (components  of  NEES)  that  are  calculated 
using  the  CEKE  and  CUKE  lie  within  the  appropriate  bounds,  and  so  are  more  accept¬ 
able  than  those  of  the  MPEKE,  which  do  not.  Reference  [18]  shows  that  a  filter — such 
as  our  MPEKE — that  estimates  its  covariance  optimistically  is  likely  to  diverge.  This 
suggests  that  the  CEKE  and  CUKE  are  more  acceptable  for  our  work  than  the  MPEKE. 
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Estimation  Target  Position  using  CEKF,  MPEKF,  CUKF  and  Actuai  Target  Position 


Figure  5:  Estimated  target  position  using  CEKF,  MPEKF,  CUKF,  together 
with  actual  target  position 


RMS  position  error  vs  time 


Figure  6:  RMS  position  errors  for  CEKF,  MPEKF,  CUKF 
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Figure  7:  RMS  position  error  at  30  minutes  versus  filter  bearing  standard 
deviation  for  several  system  bearing  standard  deviations  Oq.  Note  that  “std” 
in  each  plot  means  ag 
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(a)  ag  =  1.5°  (b)  cr^  =  2.5° 


Figure  8:  RTAMS  position  error  versus  filter  bearing  standard  deviation  for 
several  system  hearing  standard  deviations  a^.  Note  that  “std”  in  eaeh  plot 
means  Ug 
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Figure  9:  Norm  of  bias  position  error  at  30  minutes  versus  filter  bearing 
standard  deviation  for  several  system  bearing  standard  deviations  Gq.  Note 
that  “std”  in  each  plot  means  Uq 
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Figure  1 0:  log;^Q  NEES  at  30  minutes  versus  filter  bearing  standard  devia¬ 
tion  for  several  system  bearing  standard  deviations  Ug.  The  horizontal  black 
dashed  lines  across  are  the  logs  of  the  acceptable  average  bounds.  Note  that 
“std”  in  each  plot  means 
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5.2  Mismatch  of  the  Gaussian  means  used  in  the  model  and 
the  system 

This  section  presents  comparison  results  of  the  overall  performance  of  each  filter  (CEKF, 
MPEKF,  CUKE)  in  the  presence  of  bearing  measurement  mean  mismatch  between  the 
model  and  the  system  as  described  on  page  9.  That  is,  we  consider  Gaussian  system  bearing 
measurement  noises  with  means  /i  =  along  with  a  fixed  standard  deviation 

Gq  =  1.5°.  The  filters  simulate  a  bearing  noise  as  Gaussian  with  zero  mean  and  the  same 
standard  deviation  (1.5°)  as  the  system. 

In  order  to  compare  the  overall  performance  of  each  filter  having  a  bearing  mean 
mismatch  between  the  model  and  the  system,  the  following  plots  are  presented: 


Figure  11:  RMS  position  error  at  the  final  time  of  t  =  30  minutes. 

Figure  12:  RTAMS  position  error  (an  average  over  18  — ?■  30  minutes  interval), 
Figure  13:  norm  of  bias  position  error  at  t  =  30  minutes,  and 


Figure  14:  logig  NEES  at  t  =  30  minutes. 

Overall,  the  plots  show  that  if  the  mean  of  bearing  measurement  noise  of  the  model  is  not 
approximately  equal  to  that  of  the  system,  a  very  poor  TMA  is  obtained.  So  it  is  crucial 
to  have  a  filter  that  matches  the  bearing  means  of  the  model  and  system.  This  suggests 
further  research  into  filters  that  can  estimate  the  bearing  mean  adaptively. 


Figure  11:  RMS  position  error  at  30  minutes  for  filters  with  a  hearing  mean 
of  0°,  and  system  hearing  means  of  0°,  1°,  2°.  Both  system  and  filters  have 
a,  =1.5° 
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Filters 

Figure  12:  RTAMS  position  error  for  filters  with  a  bearing  mean  of  0°,  and 
system  bearing  means  of  0°,  1°,  2°.  Both  system  and  filters  have  =  1.5° 


Figure  13:  Norm  of  bias  position  error  at  30  minutes  for  filters  with  a 
bearing  mean  of  0°,  and  system  bearing  means  of  0°,  1°,  2°.  Both  system  and 
filters  have  ag  =  1.5° 
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Figure  I4:  logiQ  NEES  at  30  minutes  for  filters  with  a  bearing  mean 
of  0°,  and  system  bearing  means  of  0°,  1°,  2°.  Both  system  and  filters  have 
cjq  =  1.5°.  The  horizontal  black  dashed  lines  aeross  are  the  logs  of  the  aecept- 
able  average  bounds 
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6  Adaptive  Filters 

We  first  briefly  describe  the  adaptive  filters  (i.e.  multiple  models  techniques)  used  in  this 
paper.  Further  details  can  be  found  in  [14,  19].  These  filters  are: 

Static  multiple  models  estimator  (SMM),  and 

Dynamic  multiple  models  estimators,  namely:  Generalised  Pseudo  Bayes  methods 
(GPBl  and  GPB2)  and  the  interacting  multiple  models  method  (IMM). 


6.1  Static  Multiple  Models  Estimator  (SMM) 

The  system  is  assumed  to  obey  a  fixed  one  of  r  possible  models,  M^, . . . ,  M’’,  where  each 
model  assumes  a  different  initial  sensor  bearing  standard  deviation.  The  filter  then  changes 
its  bearing  standard  deviation  adaptively. 

To  combine  the  state  estimates  of  the  filters,  we  need  to  compute  a  weight  (i.e.  a  model 
probability)  at  time  k  associated  with  each  model  .  (These  weights  must  always  sum 
to  1  across  all  models.)  Let  the  initial  weights  follow  a  uniform  distribution:  e.g.  for 
four  models,  =  ;Ug  =  /Uq  =  /Xq  =  0.25.  The  corresponding  weights  at  time  k  can  be 
calculated  recursively  using  Bayes’  rule: 


j_  p{zk\M^) 


(6.1) 


where  p{zk\M^)  is  the  likelihood  of  measurement  Zk  given  model  M^: 

p{zk\M^)  =  exp  — -  ,  (6.2) 

where  (t|  =  is  the  innovation  variance  for  model  M^.  Here, 

and  are  the  linearised  measurement  matrix  and  predicted  covariance  for  model 

respectively,  is  the  variance  of  the  measured  angle  for  model  [see  (2.11)],  and 

Y\k-i  predicted  bearing  at  time  k  for  model  MP 

The  adaptive  state  estimate  is  obtained  as  a  weighted  sum  of  the  estimates  produced 
by  all  of  the  models: 

r 

^k\k  =  Y.^^i^i\k■  (6-3) 

1=1 

Similarly,  the  adaptive  covariance  matrix  may  be  computed  as 


^k\k 


r 


^k\k)  {^k\k 


(6.4) 


Figure  15  illustrates  the  SMM  algorithm  for  r  =  2  models.  Implementation  of  the 
algorithm  is  shown  in  Figure  16. 
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Figure  15:  Two-model  example  of  SMM  extracted  from  [14]-  The  models 
are  denoted  (dark  blue  path)  and  (light  blue  path).  Red  paths  point 
to  the  final  estimates  that  are  output  at  each  time  step 


At  time  A;  =  1,  2, ,  for  each  model  [j  =  1, . . . ,  r): 

Initialise  filters  at  the  previous  time  step  with: 

Model  estimates:  J 

Model  probabilities: 

Model  matched  filtering:  For  model  (j  =  1, . . . ,  r), 

Model  conditioned  Kalman  filter  produces  A/’(:e^|^,  P'^|^) 

Likelihood  for  model  ML  p{zk\M^)  =  p(-Zfc|M'?',  J 

calculated  in  (6.2) 

Model  probability  update: 

Combined  estimate: 


Pk\k  —  J2j=l  Rk  Pk\k  ■*“  ^k\k)  i^i\k  ^k\k) 
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Figure  16:  SMM  algorithm 
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6.2  Dynamic  Multiple  Models  Estimator 

This  type  of  estimator  models  the  system  as  evolving  according  to  one  of  r  possible  hy¬ 
potheses  or  models.  The  system  may  only  switch  between  models  at  the  discrete  times 
ti,  •  •  •  This  switching  is  assumed  to  be  Markov,  so  that  the  model  in  the  period  {tk,tk+i] 
depends  only  on  the  model  in  the  period  For  example,  initially  {t  =  to)  there 

is  just  one  model.  Over  the  time  interval  this  single  model  branches  r  times,  giv¬ 

ing  r  models  at  time  ti.  Each  of  these  models  then  branches  again,  producing  a  total  of 
hypotheses  over  {to,  ^2],  and  again  a  further  splitting  produces  hypotheses  over  (foj  ts]- 

This  exponential  growth  in  the  number  of  models  over  time  from  a  dynamic  multiple 
models  estimator  is  called  the  “hypothesis  growth  problem”.  The  GPBl,  GPB2,  and  IMM 
methods  were  proposed  as  a  means  for  controlling  such  unwanted  growth.  Each  of  these 
estimators  is  now  described  in  detail. 

Let  Ml  denote  the  regime  in  which  the  system  follows  model  M*  during  the  time 
interval  {tk-i,tk]-  We  assume  that  the  probability  pij  of  switching  from  model  M*  to 
model  is  known  and  independent  of  the  switching  time:  i.e.  pij  is 

independent  of  k  for  all  k  >  0,  and  Yl^j=iPij  —  ^  i  =  1, . . . ,  r.  Again,  demand 

the  weights  sum  to  1  and  initially  follow  a  uniform  distribution  (i.e.  /Xq  is  constant  and 
independent  of  model  M^). 

6.2.1  Generalised  Pseudo  Bayes  Methods  (GPBl  and  GPB2) 

One  of  the  first  methods  proposed  for  controlling  the  growth  of  hypotheses  for  switching 
systems  was  the  generalised  pseudo  Bayes  algorithm  (GPB).  In  the  GPB,  hypotheses  are 
merged  according  to  the  manoeuvre  history  of  the  previous  time  steps.  If  several  hy¬ 
potheses  have  the  same  manoeuvre  history  over  the  previous  n  —  1  time  intervals,  then 
these  hypotheses  are  merged,  and  the  algorithm  is  denoted  GPBn.  Thus  the  GPBn  main¬ 
tains  r”  hypotheses,  which  are  collapsed  to  r"'~^  hypotheses  at  each  time  step  following 
measurement  update. 

-  For  the  GPBl,  r  models  are  merged  to  a  single  component  every  time  step  after 
measurement  update.  All  hypothesis  histories  that  differ  only  in  older  models  are 
merged.  All  r  filters  are  effectively  reinitialised  with  the  merged  overall  estimate 
from  the  previous  time  step.  GPBl  can  be  viewed  as  an  approximation  to  the  full 
Bayesian  hypothesis  tree  multiple  model  filter,  which  considers  only  the  possible 
models  at  the  latest  time  instant  and  merges  all  possible  model  histories  into  one 
hypothesis.  The  cycle  then  repeats.  Figure  17  shows  an  example  of  r  =  2  models; 
Figure  18  presents  the  GPBl  algorithm. 

-  For  the  GPB2  an  extra  time  step  history  is  kept,  and  so  models  are  merged  to 
r  models  after  each  measurement  update.  The  GPB2  considers  models  at  the  latest 
two  time  instants,  and  merges  all  previous  model  sequences  that  end  at  the  same 
model.  Thus  the  GPB2  maintains  r  model-matched  estimates.  For  each  of  the 
r  estimates,  r  filters  corresponding  to  the  possible  model  transitions  are  run  (a  total 
of  filters).  The  updated  states  that  end  at  the  same  model  are  then  merged,  and 
the  cycle  repeats.  Figure  19  shows  an  example  of  r  =  2  models;  Figure  20  presents 
the  GPB2  algorithm. 
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Figure  17:  Two-model  example  of  GPBl  [19].  The  colours  are  the  same  as 
those  used  in  Figure  15 


At  time  k  =  1,2,...: 


Initialise  filters  at  the  previous  time  step  with: 

Combined  estimate: 

Model  probabilities:  gl._i  for  model  (j  =  1, . . . ,  r) 

Model  matched  filtering:  For  model  (j  =  1, . . . ,  r), 

Model  conditioned  Kalman  filter  produces 

Likelihood  A|,  =  p{zk\M[,X]^_i\]^_i,Pi._i\]^_i^,  where  M[  denotes 
the  regime  in  which  the  system  follows  model  during  the  time 
interval  (4-i,4] 

Model  probability  update: 

^  r  r  r 

h'i  =  jK  '^Pij  Pk-i ,  where  A  =  Y,  [^i  Tk-i 

2=1  j=l  2=1 

Combined  estimate: 


^k\k 


Pk\k 


r 


{^k\k 


T 


Figure  18:  GPBl  algorithm  extracted  from  [If,  19] 
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ig  ti  t2  time 

Figure  19:  Two-model  example  of  GPB2  [19].  The  colours  are  the  same 
as  those  used  in  Figure  15.  The  dotted  lines  at  time  ti  reflect  the  fact  that 
e.g.  the  seven  estimates  with  subscript  “1|1”  are  all  created  in  a  quick  suc¬ 
cession  that  does  not  depend  on  the  time  line;  they  can  be  considered  as  all 
being  created  at  time  ti 
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At  time  k  =  1,2,...,  for  each  model  M*  (i  =  1, . . . ,  r). 

Initialise  filters  at  the  previous  time  step  with: 

Model  estimates: 

Model  probabilities: 

Model  matched  filtering:  For  models  M*,  {i,j  =  1, . . . ,  r). 

With  denoting  the  regime  in  which  model  applies  during 
the  time  interval  (tfe_i,tfc],  the  model  conditioned  Extended 
Kalman  filter  for  takes  and  produces 

Likelihood:  k'l  =  p{2t|AL^, 

Model  merging  probabilities:  With  the  probability  that  M* 

was  in  effect  at  time  k  —  1  given  that  is  in  effect  at  time  k 
conditioned  on  the  data 

k'k-llk  ~  ~^-^k  Pij  k'k-l  1 

where  Aj  =  ^k  Pv  P^k-i  ■ 

Merging:  For  model  [j  =  1, . . . ,  r), 

r 

Ai  _  ,,^3 

'^klk  ~  /  .^k-^k'^k\k 
i=l 

pi\k =iz^^'k-l\k 

i=l 

Model  probability  update:  For  model  (j  =  1, . . .  ,r), 

=  ^k  Pij  Pk-i  =  ^ 

i=l 

where  A  =  Y3^j=i  ^j- 


^k\k^\'^k\k  '^k\k 


)( 


'^k\k  ■^k\k) 


Combined  estimate  (for  output): 


Xk\k  —  ^  k^k  ®i|fc  ’  ^k\k  —  ^  kk  ■f’ilfc  +  (®i|fc 


1=1 


1=1 


Figure  20:  GPB2  algorithm  extracted  from  [If,  19] 
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6.2.2  Interacting  Multiple  Models  Method  (IMM) 

The  IMM  is  essentially  an  approximation  to  the  GPB2,  but  only  requires  r  filters  instead 
of  the  GPB2’s  filters.  Rather  than  perform  the  merging  operation  immediately  after 
measurement  update,  the  IMM  introduces  a  merging  procedure  termed  an  “interaction” 
immediately  after  hypothesis  branching,  but  before  prediction.  The  mixture  of  assumed 
Gaussian  probability  densities  is  approximated  by  a  single  Gaussian  density  via  moment 
matching.  The  merging  process  is  therefore  moved  backwards  by  almost  a  full  filter  cycle. 
Consequently,  it  is  no  longer  required  to  carry  out  the  prediction  and  measurement  update 
operations  for  branching  hypotheses,  but  only  for  the  r  merged  hypotheses.  Figure  21 
shows  an  example  with  r  =  2  models;  Figure  22  presents  the  IMM  algorithm. 


^  to  ^  ^  h  ^  ^ 


Figure  21:  Two-model  example  of  IMM  [19],  The  colours  and  use  of  the 
dotted  sections  on  the  time  axis  are  the  same  as  used  in  previous  figures 
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At  time  /c  =  1,  2, . . . ,  for  model  M*  (i  =  1, . . . ,  r), 

Initialise  filters  at  the  previous  time  step  with: 

Model  estimate:  N 
Model  probabilities: 

Mixing  probabilities:  For  models  M^,M^  {i,j  =  with 

the  probability  that  M*  was  in  effect  at  /c  —  1  given  that  is  in 

effect  at  k  conditioned  on  the  data  up  to  and  including  time  k  —  1, 

1  •  _  *■  . 

Pij  4-i|fc-i  >  where  Aj  = 

^  i=l 

Mixing:  For  model  {j  =  1, . . . ,  r), 

i=l 


r 


i=l 


:.0i 


Model  matched  filtering:  For  model  {j  =  1, . . .  ,r), 

Prediction:  „ .  .  „  . 

~  Oj 

•^k\k-l  ~  k  -^k-^k-l 


Update: 


pOi  _  fpj  t3^3  J- 

^ k\k-l  ~  k  ^ k-l\k-l  ^  k  “TVfc 

Zk\k-1  =  as  in  (2.10) 

j  _  dhk{x)^ 

=  +  W)i 

vl  =  Zk-  Zk\k-1 

/i.j  —  I 

•^klk  ~  -^klk-l  ^  ^k^k 

Al~M(rl-.o,si) 


Model  probability  npdate:  For  model  {j  =  1, . . .  ,r), 
^^k\k  =  where  A  =  A|  Ai. 

Combined  estimate  (for  output): 


i=i 


k  ‘^klk  ■ 


-Pfc|A:  —  E  d|fc 

i=i 


^klk  +  (^klk  ®fc|fc)  ®fc|fc) 
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Figure  22:  IMM  algorithm  extracted  from  [19] 
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7  Adaptive  Filters  Results 

This  section  presents  an  analysis  of  whether  the  adaptive  filters  of  Section  6  (SMM,  GPBl, 
GPB2,  IMM)  might  be  of  benefit  when  a  filter  lacks  knowledge  of  the  measurement  noises 
(e.g.  variance  or  biases).  To  this  end,  we  investigate  how  to  compute  a  filter  bearing 
standard  deviation  adaptively. 

The  scenario  and  parameters  described  in  Section  4  are  used  here  (we  may  recall 
that  the  “true”  sensor  gq  =  1.5°),  except  now  the  filters  do  not  “know”  this  standard 
deviation.  The  parameters  defined  in  Section  6  and  used  specifically  for  adaptive  filters 
are  summarised  as  follows: 

-  We  use  four  models;  i.e.  r  =  4  in  Section  6.  These  models  ,  j  =  1,  2,  3, 4,  use  initial 
sensor  bearing  standard  deviations  of  1.5°,  2.5°,  3.5°,  4.5°  respectively.  That  is, 

ar'  =  l-5°,  ur"  =  2.5°, 

a^  =  ^  =  3.5°,  =  = 

-  Initial  uniform  weights  for  each  model  are  /Xq  =  fiQ  =  /Uq  =  /Uq  =  0.25,  and 

0.85  0.05  0.05  0.05' 

0.05  0.85  0.05  0.05 
0.05  0.05  0.85  0.05  ’ 

0.05  0.05  0.05  0.85_ 

where  each  row  (but  not  column)  of  the  matrix  of  pij  is  required  to  sum  to  1.  Note  that  the 
Pij  are  only  used  for  the  dynamic  multiple  models  estimators;  GPBl,  GPB2,  and  IMM. 

The  NEES  analysis  at  the  end  of  Section  5.1  concluded  that  the  GEKF  and  CUKE  out¬ 
perform  the  MPEKE  in  the  presence  of  bearing  measurement  variance  mismatch  between 
the  model  and  the  system.  Because  of  this,  we  have  restricted  the  following  analysis  to 
adaptive  filters  using  GEKEs  (comparing  these  with  the  CEKE  single- model  result),  and 
then  adaptive  filters  using  CUKFs  (comparing  these  with  the  CUKE  single-model  result). 
We  present  results  based  on  two  classes  of  problem,  as  follows: 

Section  7.1  deals  with  the  static  sensor  performance  case;  hence  the  SMM  is  applicable 
here. 

Section  7.2  deals  with  the  dynamic  sensor  performance  case;  hence  GPBl,  GPB2,  and 
IMM  are  applicable. 

7.1  Static  sensor  performance  case 

This  case  deals  with  the  SMM.  We  compare  each  standard  filter  (CEKE,  GUKF)  hav¬ 
ing  a  bearing  standard  deviation  matched  to  that  of  the  system  (which  takes  the  val¬ 
ues  1.5°,  2.5°,  3.5°,  4.5°  in  turn)  with  the  SMM  (using  multiple  GEKEs  and  GUKFs). 
We  let  the  SMM  determine  its  filter  bearing  standard  deviation  adaptively  (again  from 
1.5°— 7-  4.5°).  For  brevity  we  only  present  the  results  for  system  bearing  standard  devia¬ 
tions  of  1.5°  and  2.5°,  because  the  cases  for  3.5°  and  4.5°  show  similar  trends. 

A  comparison  of  the  effectiveness  of  the  SMM  with  the  standard  filters  is  made  as 
follows.  For  each  of  the  system  bearing  standard  deviations,  we  plot 
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Figure  23:  model  probabilities  versus  time  (averaged  over  100  Monte  Carlo  runs), 
Figure  24:  RMS  position  error  versus  time, 

Figure  25:  RTAMS  position  error  (an  average  over  the  18  — )•  30  minutes  interval)  versus 
filter  type. 

Figure  26:  norm  of  bias  position  error  at  30  minutes  versus  filter  type,  and 
Figure  27:  NEES  versus  time. 

The  graph  legends  are  annotated  as  follows: 

CEKF  denotes  the  standard  CEKF, 

SMM-CEKF  denotes  the  adaptive  filter  SMM  (using  multiple  CEKEs), 

CUKF  as  for  “CEKF”  above,  but  now  using  the  CUKE,  and 

SMM-CUKF  as  for  “SMM-CEKF”  above,  but  now  using  multiple  CUKFs. 

The  results  show  that  the  SMM  can  estimate  its  bearing  standard  deviation  adaptively; 
that  is,  it  matches  the  value  to  that  of  the  system  (Figure  23  shows  higher  probability  for 
this  case).  The  SMM  performance  results  are  comparable  to  those  of  the  filter  that  uses 
a  bearing  standard  deviation  matched  to  the  system.  The  CUKF  performs  slightly  better 
than  the  CEKF.  Also,  most  of  the  NEES  values  fall  inside  the  acceptable  bounds. 


(a)  System  Og  =  1.5° 


(b)  System  (jg  =  2.5° 


Figure  23:  SMM-CEKF  model  probabilities  versus  time  for  two  sys¬ 
tem  bearing  standard  deviations,  averaged  over  100  Monte  Carlo  runs. 
The  SMM-CUKF  shows  similar  trends  and  so  is  not  shown  here;  Ml-Mf 
denote  models  with  bearing  standard  deviations  of  1.5°,  2.5° ,  3.5° ,  f.5°  re¬ 
spectively.  In  both  plots,  the  model  whose  bearing  standard  deviation  matches 
that  of  the  system  soon  becomes  dominant,  showing  that  the  filter  successfully 
matches  its  bearing  error  to  that  of  the  system 
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Figure  24:  RMS  position  error  versus  time  for  two  system  bearing  standard 
deviations 


(a)  System  =  1.5° 


(b)  System  ag  =  2.5° 


Figure  25:  RTAMS  position  error  versus  filter  type  for  two  system  bearing 
standard  deviations 
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(a)  System  Og  =  1.5°  (b)  System  ag  =  2.5° 

Figure  26:  Norm  of  bias  position  error  at  t  =  30  minutes  versus  filter  type 
for  two  system  bearing  standard  deviations 


(b)  System  ag  =  2.5° 


Figure  27:  NEES  versus  time  for  two  system  bearing  standard  deviations. 
The  horizontal  black  dashed  lines  across  are  the  acceptable  bounds 
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7.2  Dynamic  sensor  performance  case 

Here  we  consider  the  dynamic  multiple  models  estimators:  GPBl,  GPB2,  IMM.  The 
dynamic  sensor  performance  is  based  on  using  two  fixed  bearing  standard  deviations,  one 
for  each  half  of  the  scenario.  We  consider  two  cases: 

-  The  first  half  scenario  uses  1.5°  and  the  second  half  scenario  uses  2.5°  standard 
deviation;  and 

-  The  first  half  scenario  uses  2.5°  and  the  second  half  scenario  uses  3.5°  standard 
deviation. 

For  each  case  of  the  dynamic  sensor  performance,  we  compare  each  ideal  filter  (using 
GEKF — having  a  bearing  standard  deviation  matched  to  that  of  the  system — with  the 
adaptive  filters  (using  multiple  GEKFs).^  The  adaptive  filters  determine  their  own  best 
value  of  the  filter  bearing  standard  deviation  from  the  set  {1.5°,  2.5°,  3.5°,  4.5°}. 

In  order  to  compare  the  effectiveness  of  the  adaptive  filters  with  each  ideal  filter,  we  plot 

Figure  28:  model  probabilities  versus  time  (averaged  over  100  Monte  Garlo  runs). 
Figure  29:  RMS  position  error  versus  time, 

Figure  30:  RTAMS  position  error  (an  average  over  the  18  — )■  30  minutes  interval)  versus 
filter  type. 

Figure  31:  norm  of  bias  position  error  at  30  minutes  versus  filter  type,  and 
Figure  32:  NEES  versus  time. 

The  graph  legends  use  the  following  terms: 

Ideal  denotes  the  ideal  filter  (using  GEKF), 

GPBl  denotes  the  adaptive  filter  GPBl  (using  multiple  GEKFs), 

GPB2  as  for  GPBl  above,  but  now  using  the  adaptive  filter  GPB2  (with  multiple  GEKFs), 
and 

IMM  as  for  GPBl  and  GPB2  above,  but  now  using  the  adaptive  filter  IMM  (with  multiple 
GEKFs). 

Our  results  indicate  that  the  adaptive  filters  (GPBl,  GPB2,  IMM)  can  determine  their 
own  bearing  standard  deviation  with  reasonable  success.  For  example.  Figure  28  shows 
that  the  model  weights  for  bearing  errors  equal  to  those  of  the  system  do  attain  some 
dominance  over  competing  weights  over  the  course  of  the  scenario,  although  this  dominance 
is  not  strong.  That  is,  in  Figure  28(a)  we  expect  model  to  become  dominant  in  the  first 
half  of  the  scenario,  with  model  dominating  in  the  second  half.  This  is  mostly  what 
happens,  although  the  model  domination  is  not  overly  pronounced.  In  Figure  28(b) 
we  expect  model  to  become  dominant  in  the  first  half  of  the  scenario,  followed  by 

^Analogous  results  for  the  CUKF  show  similar  trends  to  those  of  the  CEKF  and  so  are  not  presented 
here. 
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model  in  the  second  half.  The  effect  is  less  obvious  here,  and  model  also  becomes 
prominent. 

These  filters  show  performance  comparable  to  that  of  an  ideal  filter  that  uses  the  same 
dynamic  bearing  standard  deviations  as  those  of  the  system.  Figure  29  shows  that  the 
IMM  and  GPB2  perform  marginally  more  closely  to  the  ideal  filter  than  does  the  GPBl. 
The  GPBl  may  be  marginally  better  than  the  GPB2  and  the  IMM,  giving  slightly  smaller 
errors  in  Figures  29-31.  Figure  32  shows  that  the  state  covariances  calculated  using  the 
IMM  and  GPB2  are  more  acceptable  under  the  test  for  consistency  (i.e.  more  NEES  fall 
inside  the  acceptable  x^  bounds),  and  are  closer  to  those  of  an  ideal  filter.  The  computer 
processing  times  required  for  running  the  IMM  and  GPBl  algorithms  are  roughly  similar, 
and  are  about  half  of  the  time  required  to  run  the  GPB2  routine.  For  these  reasons,  the 
IMM  seems  slightly  more  promising  to  use. 


(a)  System  Og  =  1.5°  then  2.5°,  GPBl  (b)  System  Og  =  2.5°  then  3.5°,  GPBl 

Figure  28:  Model  probabilities  versus  time  for  two  dynamic  system  bearing 
standard  deviations:  (a)  1.5°  for  the  first  half  scenario  and  2.5°  for  the 
second  half  scenario  (left),  (b)  2.5°  for  the  first  half  scenario  and  3.5°  for  the 
second  half  scenario  (right)  (GPBl  using  CEKF  only;  the  GPB2  and  IMM 
show  similar  trends  and  so  are  not  shown  here);  Ml-Mf  denote  models  with 
bearing  standard  deviations  of  1.5°,  2.5°,  3.5°,  4-5°  respectively. 
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Figure  29:  RMS  position  error  versus  time  for  eaeh  system  with  dynamic 
bearing  standard  deviations:  (a)  1.5^  for  the  first  half  seenario  and  2.5^  for 
the  seeond  half  scenario,  (b)  2.5^  for  the  first  half  scenario  and  5.5°  for  the 
second  half  scenario  (CEKF  only) 


(a) 


(b) 


Figure  30:  RTAMS  position  error  (averaged  overt  =  18  — )•  30  minutes)  for 
all  filters,  for  each  system  with  dynamic  bearing  standard  deviations:  (a)  1.5^ 
for  the  first  half  scenario  and  5.5°  for  the  seeond  half  scenario,  (b)  2.5°  for 
the  first  half  scenario  and  3.5°  for  the  second  half  scenario  (CEKF  only) 
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Filters  Filters 

(a)  (b) 


Figure  31:  Norm  of  bias  position  error  at  30  minutes  for  all  filters,  for 
each  system  with  dynamic  bearing  standard  deviations:  (a)  1.5°  for  the  first 
half  scenario  and  2.5°  for  the  second  half  scenario,  (b)  2.5°  for  the  first  half 
scenario  and  3.5°  for  the  second  half  scenario  (CEKF  only) 


Figure  32:  NEES  versus  time  for  each  system  with  dynamic  bearing  stan¬ 
dard  deviations:  (a)  1.5°  for  the  first  half  scenario  and  2.5°  for  the  second 
half  scenario,  (b)  2.5°  for  the  first  half  scenario  and  3.5°  for  the  second 
half  scenario  (CEKF  only).  The  horizontal  dashed  lines  are  the  acceptable 
bounds 
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Figure  33:  CPU  time  per  simulation  run  for  the  adaptive  filters  (CEKF 
only) 


GPB1  GPB2  IMM 

Adaptive  filters 
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8  Conclusion  and  Future  Directions 

In  this  report  we  have  presented  a  benchmark  of  existing  bearings-only  TMA  algorithms 
that  are  designed  to  cope  with  model  uncertainty.  The  standard  algorithms  used  were 
CEKF,  MPEKF,  CUKE.  The  main  thrust  of  the  report  was  the  design  of  algorithms  to 
cope  with  models  mismatch:  the  adaptive  filters  SMM,  GPBl,  GPB2,  IMM.  These  filters 
were  designed  to  be  able  to  estimate  and  adjust  the  measurement  noise  parameters  as  new 
data  comes  in. 

In  order  to  estimate  the  target  state  accurately,  the  estimator  needs  to  know  the 
statistical  characteristics  of  the  measurement  noise:  its  bias  (mean)  and  spread  (variance). 
But  this  information  tends  to  be  blurred  by  factors  such  as  frequency,  signal-to-noise 
ratio  (SNR),  bearing,  bearing  rate,  and  array  type,  so  filters  using  a  wrong  bearing  mean 
or  variance  can  give  very  poor  TMA.  We  have  concentrated  on  finding  the  variances 
of  measurement  noises  adaptively.  The  adaptive  filters  show  promise  in  being  able  to 
determine  what  bearing  variance  they  should  use.  We  stress  that  this  is  a  theoretical 
investigation,  and  propose  to  investigate  further  using  real  data. 

We  are  also  concerned  solely  with  single  sensor /single  non-manoeuvring  target  tracking 
(e.g.  tracking  a  ship  or  a  submarine).  Both  static  and  dynamic  sensor  performances  were 
considered.  For  simplicity,  the  measurement  noise  used  was  restricted  to  Gaussian. 

Our  key  results  are  summarised  as  follows.  They  have  been  tested  on  three  scenarios 
encompassing  low  to  high  rates  of  bearing  change: 

-  The  CUKE  and  GEKF  perform  better  than  the  MPEKF  for  our  scenarios; 

~  Filters  incorporating  approximately  the  same  bearing  mean  and  error  as  those  of  the 
system  outperform  filters  that  are  not  matched  in  such  a  way; 

-  Adaptive  filters  (that  tune  their  own  model  of  the  bearing  variance)  show  promise 
for  use. 

Further  work  can  be  done  in  the  following  areas: 

-  As  stated  above,  this  work  is  a  theoretical  investigation.  Future  work  aims  to  validate 
using  real  data. 

-  We  can  model  the  dynamic  sensor  performance  to  be  more  realistic;  e.g.  rather 
than  use  two  fixed  bearing  standard  deviations  for  each  half  of  the  scenario,  we  can 
make  the  bearing  standard  deviation  change  progressively  with  time.  This  could  be 
implemented  with  a  random  walk  model. 

-  We  can  also  use  the  SNR  to  model  the  fluctuating  bearing  error  distribution  during 
the  simulation;  e.g.  a  lower  SNR  suggests  a  long-range  target  and  a  higher  SNR 
suggests  a  short-range  target.  This  information  allows  compilation  of  a  look-up 
table  of  standard  deviation  versus  time. 

-  Non-Gaussian  measurement  noise  can  be  modelled. 

-  Finally,  the  work  with  adaptive  filters  can  be  extended  to  the  case  of  a  manoeuvring 
target. 


36 


DSTO-TR-2405 


9  Acknowledgements 

We  wish  to  thank  Mr  Warren  Smith,  Dr  Derek  Bertilone,  Dr  Dragana  Carevic,  Ms  Fiona 
Gianoli,  Mr  Michael  Beard  and  Ms  Cheryl  Smith-Gander  for  assistance  in  the  sonar  areas 
and  scenario  parameter  settings.  Especial  thanks  go  to  Dr  Sanjeev  Arulampalam  for  his 
valuable  comments,  discussions,  encouragement  and  critical  reading  of  the  manuscript. 
Finally,  but  not  least,  we  also  wish  to  thank  Dr  Mark  Rutten  (Intelligence,  Surveillance 
and  Reconnaissance  Division — ISRD)  for  kindly  spending  his  time  reviewing  this  report. 


References 

1.  AFTP  20  (2004),  Australian  Submarine  Tactical  Instructions  (U),  SECRET  AGAO. 

2.  S.  Julier,  J.K.  Uhlmann  (1997),  “A  New  Extension  of  the  Kalman  Filter  to  Nonlinear 
Systems”,  SPIE  AeroSense  Symposium/Defense  Sensing,  Simulations  and  Controls. 

3.  G.  Welch,  G.  Bishop  (2006),  An  Introduction  to  the  Kalman  Filter,  TR  95-041,  De¬ 
partment  of  Computer  Science,  University  of  North  Carolina  at  Chapel  Hill. 

4.  P.S.  Maybeck  (1994),  Stochastic  Models  Estimation  and  Control,  Vol.  1,  Navtech  Book 
and  Software  Store,  New  York. 

5.  B.D.O.  Anderson,  J.B.  Moore  (1979),  Optimal  Filtering,  Prentice-Hall. 

6.  S.  Stergios  (2001),  Advanced  Signal  Processing  Handbook:  Theory  and  Implementation 
for  Radar,  Sonar,  and  Medical  Imaging  Real-Time  Systems,  CRC  Press,  Boca  Raton, 
London. 

7.  A.  Zaknich  (2005),  Advanced  Textbooks  in  Control  and  Signal  Processing:  Principles 
of  Adaptive  Filters  and  Self-learning  Systems,  Springer  Publishing. 

8.  S.  Arulampalam  (2000),  A  Comparison  of  Recursive  Style  Angle-only  Target  Motion 
Analysis  Algorithms,  DSTO  Technical  Report  DSTO-TR-0917. 

9.  J.C.  Hassab  (1989),  Underwater  Signal  and  Data  Processing,  PhD  thesis,  CRC  Press, 
Boca  Raton,  Florida,  USA. 

10.  V.J.  Aidala,  S.E.  Hammel  (1983),  “Utilization  of  modified  polar  coordinates  for 
bearings-only  tracking”,  IEEE  Trans.  Automatic  Control,  28  (3),  283-294. 

11.  B.  Ristic,  S.  Arulampalam,  N.  Gordon  (2004),  Beyond  the  Kalman  Filter:  Particle 
Filters  for  Tracking  Applications,  Artech  House. 

12.  S.  Julier,  J.  Uhlmann,  H.F.  Durrant- Whyte  (2000),  “Technical  Notes  and  Correspon¬ 
dence:  A  new  method  for  the  nonlinear  transformation  of  means  and  covariances  in 
filters  and  estimators”,  IEEE  Trans.  Automatic  Control,  45,  3. 

13.  R.W.  Osborne  HI,  Y.  Bar-Shalom  (2006),  “Radar  Measurement  Noise  Variance  Esti¬ 
mation  with  Targets  of  Opportunity”,  IEEE  Aerospace  Conference. 


37 


DSTO-TR-2405 


14.  Y.  Bar-Shalom,  X.R.  Li,  T.  Kirubarajan  (2001),  Estimation  with  Applications  to 
Tracking  and  Navigation,  John  Wiley  &:  Sons. 

15.  A.  Chapman,  T.W.  Josefsson  (1999),  ASWEX  98,  Initial  Analysis  and  Reconstruc¬ 
tion  (U),  DSTO  Technical  Report  DSTO-TR-0967,  CONFIDENTIAL. 

16.  RAN  web  page  http :  / / www .  navy .  gov .  an 

17.  S.  Arulampalam,  M.  Clark,  R.  Vinter  (2007),  “Performance  of  the  Shifted  Rayleigh 
Filter  in  Single-sensor  Bearings-only  Tracking”,  Proc.  of  Eusion  2007,  Canada. 

18.  V.J.  Aidala  (1979),  “Kalman  Filter  Behavior  in  Bearings-Only  Tracking  Applications”, 
IEEE  Trans.  Aerospace  and  Electronic  Systems,  15,  1. 

19.  B.  Ristic,  N.  Gordon  (2005),  Multisensor  Tracking  and  Identification,  CSSIP. 


38 


Page  classification;  UNCLASSIFIED 


DEFENCE  SCIENCE  AND  TECHNOLOGY  ORGANISATION  i  caveat/privacy  marking 
DOCUMENT  CONTROL  DATA 

2.  TITLE  3.  SECURITY  CLASSIFICATION 

Investigation  of  Target  Motion  Analysis  in  the  Document  (U) 

Presence  of  Model  Uncertainty  Title  (U) 

Abstract  (U) 

4.  AUTHORS  5.  CORPORATE  AUTHOR 

T.Q.S.  Truong  and  D.  Koks  Defence  Science  and  Technology  Organisation 

PO  Box  1500 

Edinburgh,  SA  5111,  Australia 

6a.  DSTO  NUMBER  6b.  AR  NUMBER  6c.  TYPE  OF  REPORT  7.  DOCUMENT  DATE 

DSTO-TR-2405  AR-014-751  Technical  Report  May,  2010 

8.  FILE  NUMBER  9.  TASK  NUMBER  10.  SPONSOR  11.  No.  OF  PAGES  12.  No.  OF  REFS 

2009/1106908/1  07/093 _  DGSM  _ [_38 _ [jT _ 

13.  URL  OF  ELECTRONIC  VERSION  14.  RELEASE  AUTHORITY 

http://www.dsto.defence.gov.au/corporate/  Chief,  Maritime  Operations  Division 

reports/DSTO-TR-2405.pdf 

15.  SECONDARY  RELEASE  STATEMENT  OF  THIS  DOCUMENT 

Approved  for  Public  Release 

OVERSEAS  ENQUIRIES  OUTSIDE  STATED  LIMITATIONS  SHOULD  BE  REFERRED  THROUGH  DOCUMENT  EXCHANGE,  PO  BOX  1500, 
EDINBURGH,  SA  5111 _ 

16.  DELIBERATE  ANNOUNCEMENT 

No  Limitations 

17.  CITATION  IN  OTHER  DOCUMENTS 

No  Limitations 

18.  DSTO  RESEARCH  LIBRARY  THESAURUS 

Kalman  filters 
adaptive  filters 
target  tracking 

19.  ABSTRACT 

This  paper  presents  the  results  of  an  investigation  of  target  motion  analysis  algorithms  that  are  designed 
to  cope  with  model  uncertainty.  First,  some  standard  recursive  algorithms  such  as  the  cartesian  ex¬ 
tended  Kalman  filter,  modified  polar  extended  Kalman  filter,  and  cartesian  unscented  Kalman  filter  are 
applied  to  a  target  motion  analysis  problem  with  model  uncertainty,  in  order  to  analyse  the  robustness 
of  such  algorithms  in  these  conditions.  Next,  some  adaptive  algorithms  are  investigated.  They  are  the 
static  multiple  models  and  the  dynamic  multiple  models  estimators,  namely:  two  generalised  pseudo 
Bayes  methods  and  the  interacting  multiple  model  method.  In  this  paper,  the  problem  is  restricted 
to  a  single  sensor  and  a  single  non-manoeuvring  target  that  travels  at  constant  velocity.  Both  static 
and  dynamic  sensor  performances  are  considered.  For  simplicity,  only  Gaussian  measurement  noise  is 
considered.  Adaptive  filters  are  shown  to  have  promise;  they  can  establish  a  useful  bearing  standard 
deviation  adaptively  and  robustly. 

Page  classification;  UNCLASSIFIED 


tracking  filters 
filters 


